function [I_q, I_d] = calIqId(current_u, current_v, angle_el)
    % 计算 I_alpha 和 I_beta
    I_alpha = current_u;
    I_beta = (1.0 / sqrt(3)) * current_u + (2.0 / sqrt(3)) * current_v;
    
    % 计算 cos 和 sin
    ct = cos(angle_el);
    st = sin(angle_el);
    
    % 计算 I_q 和 I_d
    I_q = I_beta * ct - I_alpha * st;
    I_d = I_alpha * ct + I_beta * st;
    
    % 打印结果（可选）
    % fprintf('U: %f, V: %f, angle: %f, I_q: %f, I_d: %f\n', current_u, current_v, angle_el, I_q, I_d);
end

